Universal Lidar Autofocus System